/**
 * Copyright (c) 2014 - 2018, Nordic Semiconductor ASA
 * 
 * All rights reserved.
 * 
 * Redistribution and use in source and binary forms, with or without modification,
 * are permitted provided that the following conditions are met:
 * 
 * 1. Redistributions of source code must retain the above copyright notice, this
 *    list of conditions and the following disclaimer.
 * 
 * 2. Redistributions in binary form, except as embedded into a Nordic
 *    Semiconductor ASA integrated circuit in a product or a software update for
 *    such product, must reproduce the above copyright notice, this list of
 *    conditions and the following disclaimer in the documentation and/or other
 *    materials provided with the distribution.
 * 
 * 3. Neither the name of Nordic Semiconductor ASA nor the names of its
 *    contributors may be used to endorse or promote products derived from this
 *    software without specific prior written permission.
 * 
 * 4. This software, with or without modification, must only be used with a
 *    Nordic Semiconductor ASA integrated circuit.
 * 
 * 5. Any software provided in binary form under this license must not be reverse
 *    engineered, decompiled, modified and/or disassembled.
 * 
 * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS
 * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
 * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE
 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
 * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 * 
 */
/** @file
 *
 * @defgroup ble_sdk_uart_over_ble_main main.c
 * @{
 * @ingroup  ble_sdk_app_nus_eval
 * @brief    UART over BLE application main file.
 *
 * This file contains the source code for a sample application that uses the Nordic UART service.
 * This application uses the @ref srvlib_conn_params module.
 */


#include <stdint.h>
#include <string.h>
#include "nordic_common.h"
#include "nrf.h"
#include "ble_hci.h"
#include "ble_advdata.h"
#include "ble_advertising.h"
#include "ble_conn_params.h"
#include "nrf_sdh.h"
#include "nrf_sdh_soc.h"
#include "nrf_sdh_ble.h"
#include "nrf_ble_gatt.h"
#include "nrf_ble_qwr.h"
#include "app_timer.h"
#include "ble_nus.h"
#include "app_uart.h"
#include "app_util_platform.h"
#include "bsp_btn_ble.h"
#include "nrf_pwr_mgmt.h"
#include "nrf_power.h"

#include "FreeRTOS.h"
#include "task.h"
#include "timers.h"
#include "semphr.h"
#include "nrf_rtc.h"


#if defined (UART_PRESENT)
#include "nrf_uart.h"
#endif
#if defined (UARTE_PRESENT)
#include "nrf_uarte.h"
#endif

#include "nrf_log.h"
#include "nrf_log_ctrl.h"
#include "nrf_log_default_backends.h"
#include "nrf_delay.h"
#include "w25q128.h"
#include "data_handle.h"
#include "nrf_drv_timer.h"

#include "lcd_display.h"
#include "player.h"

#include "ble_db_discovery.h"
#include "ble_nus_c.h"

#include "algo_distance.h"
#include "m_data_handle.h"

#include "hr_task.h"

#include "nrf_dfu_ble_svci_bond_sharing.h"
#include "nrf_svci_async_function.h"
#include "nrf_svci_async_handler.h"
#include "ble_dfu.h"
#include "nrf_power.h"
#include "nrf_bootloader_info.h"

#include "ble_gdx.h"

#define APP_BLE_CONN_CFG_TAG            1                                           /**< A tag identifying the SoftDevice BLE configuration. */

#define DEVICE_NAME                     "HEART_BELT"                               /**< Name of device. Will be included in the advertising data. */
//#define DEVICE_NAME                     "NRF52840_DEMO"                               /**< Name of device. Will be included in the advertising data. */

#define NUS_SERVICE_UUID_TYPE           BLE_UUID_TYPE_VENDOR_BEGIN                  /**< UUID type for the Nordic UART Service (vendor specific). */

#define APP_BLE_OBSERVER_PRIO           3                                           /**< Application's BLE observer priority. You shouldn't need to modify this value. */

#define APP_ADV_INTERVAL                64                                          /**< The advertising interval (in units of 0.625 ms. This value corresponds to 40 ms). */

#define APP_ADV_DURATION                0                                       /**< The advertising duration (180 seconds) in units of 10 milliseconds. */

#define MIN_CONN_INTERVAL               MSEC_TO_UNITS(30, UNIT_1_25_MS)             /**< Minimum acceptable connection interval (20 ms), Connection interval uses 1.25 ms units. */
#define MAX_CONN_INTERVAL               MSEC_TO_UNITS(50, UNIT_1_25_MS)             /**< Maximum acceptable connection interval (75 ms), Connection interval uses 1.25 ms units. */
#define SLAVE_LATENCY                   0                                           /**< Slave latency. */
#define CONN_SUP_TIMEOUT                MSEC_TO_UNITS(4000, UNIT_10_MS)             /**< Connection supervisory timeout (4 seconds), Supervision Timeout uses 10 ms units. */
#define FIRST_CONN_PARAMS_UPDATE_DELAY  APP_TIMER_TICKS(5000)                       /**< Time from initiating event (connect or start of notification) to first time sd_ble_gap_conn_param_update is called (5 seconds). */
#define NEXT_CONN_PARAMS_UPDATE_DELAY   APP_TIMER_TICKS(30000)                      /**< Time between each call to sd_ble_gap_conn_param_update after the first call (30 seconds). */
#define MAX_CONN_PARAMS_UPDATE_COUNT    3                                           /**< Number of attempts before giving up the connection parameter negotiation. */

#define DEAD_BEEF                       0xDEADBEEF                                  /**< Value used as error code on stack dump, can be used to identify stack location on stack unwind. */

#define UART_TX_BUF_SIZE                256                                         /**< UART TX buffer size. */
#define UART_RX_BUF_SIZE                256                                         /**< UART RX buffer size. */

//#define POWER_OFF_TIME_CNT  (10*60) //无心率测量状态，自动关机时间，单位：秒

#define SCAN_INTERVAL           0x00A0                                  /**< Determines scan interval in units of 0.625 millisecond. */
#define SCAN_WINDOW             0x0050                                  /**< Determines scan window in units of 0.625 millisecond. */
#define SCAN_DURATION           0x0000                                  /**< Timout when scanning. 0x0000 disables timeout. */

#define MIN_CONNECTION_INTERVAL MSEC_TO_UNITS(20, UNIT_1_25_MS)         /**< Determines minimum connection interval in millisecond. */
#define MAX_CONNECTION_INTERVAL MSEC_TO_UNITS(75, UNIT_1_25_MS)         /**< Determines maximum connection interval in millisecond. */
#define SLAVE_LATENCY           0                                       /**< Determines slave latency in counts of connection events. */
#define SUPERVISION_TIMEOUT     MSEC_TO_UNITS(4000, UNIT_10_MS)         /**< Determines supervision time-out in units of 10 millisecond. */

#define ECHOBACK_BLE_UART_DATA  1                                       /**< Echo the UART data that is received over the Nordic UART Service back to the sender. */


//定义广播初始化配置结构体变量
ble_advertising_init_t adv_config = {0};

static const uint16_t belt_id = 0x0105;     //手表ID，作为手表的唯一标识符，需要注意大小端的问题

#if NRF_MODULE_ENABLED(BLE_GDX)
BLE_GDX_DEF(m_gdx, NRF_SDH_BLE_TOTAL_LINK_COUNT);                                   /**< BLE GDX service instance. */
#endif

BLE_NUS_DEF(m_nus, NRF_SDH_BLE_TOTAL_LINK_COUNT);                                   /**< BLE NUS service instance. */
NRF_BLE_GATT_DEF(m_gatt);                                                           /**< GATT module instance. */
NRF_BLE_QWR_DEF(m_qwr);                                                             /**< Context for the Queued Write module.*/
BLE_ADVERTISING_DEF(m_advertising);                                                 /**< Advertising module instance. */

uint16_t   m_conn_handle_rb       = BLE_CONN_HANDLE_INVALID;                 /**< Handle of the current connection. */
uint16_t   m_conn_handle          = BLE_CONN_HANDLE_INVALID;                 /**< Handle of the current connection. */
static uint16_t   m_ble_nus_max_data_len = BLE_GATT_ATT_MTU_DEFAULT - 3;            /**< Maximum length of data (in bytes) that can be transmitted to the peer by the Nordic UART service module. */
static ble_uuid_t m_adv_uuids[]          =                                          /**< Universally unique service identifier. */
{
    {BLE_UUID_NUS_SERVICE, NUS_SERVICE_UUID_TYPE}
};

BLE_NUS_C_DEF(m_ble_nus_c);                                             /**< BLE NUS service client instance. */
BLE_DB_DISCOVERY_DEF(m_db_disc);                                        /**< DB discovery module instance. */

static uint8_t m_scan_buffer_data[BLE_GAP_SCAN_BUFFER_MIN]; /**< buffer where advertising reports will be stored by the SoftDevice. */

/**@brief Pointer to the buffer where advertising reports will be stored by the SoftDevice. */
static ble_data_t m_scan_buffer =
{
    m_scan_buffer_data,
    BLE_GAP_SCAN_BUFFER_MIN
};

/** @brief Parameters used when scanning. */
static ble_gap_scan_params_t const m_scan_params =
{
    .active   = 1,
    .interval = SCAN_INTERVAL,
    .window   = SCAN_WINDOW,
    .timeout          = SCAN_DURATION,
    .scan_phys        = BLE_GAP_PHY_1MBPS,
    .filter_policy    = BLE_GAP_SCAN_FP_ACCEPT_ALL,
};

/**@brief NUS uuid. */
static ble_uuid_t const m_nus_uuid =
{
    .uuid = BLE_UUID_NUS_C_SERVICE,
    .type = NUS_SERVICE_UUID_TYPE
};

/**@brief Connection parameters requested for connection. */
static ble_gap_conn_params_t const m_connection_param =
{
    (uint16_t)MIN_CONNECTION_INTERVAL,  // Minimum connection
    (uint16_t)MAX_CONNECTION_INTERVAL,  // Maximum connection
    (uint16_t)SLAVE_LATENCY,            // Slave latency
    (uint16_t)SUPERVISION_TIMEOUT       // Supervision time-out
};

//定时器
static TimerHandle_t timer_100ms;       //10hz timer
TimerHandle_t timer_50ms;               //20hz timer
TimerHandle_t timer_sport;
TimerHandle_t timer_10ms;

//显示刷新任务
static TaskHandle_t task_display_thread;

//语音播放任务
static TaskHandle_t task_audio_play_thread;

//设备控制管理任务
static TaskHandle_t task_sys_mng_thread;

//训练任务
static TaskHandle_t task_train_thread;

//心率任务
static TaskHandle_t task_hr_thread;


//定时器周期：100ms
#define TIMER_PERIOD_100MS      pdMS_TO_TICKS(100)

#define TIMER_PERIOD_50MS      pdMS_TO_TICKS(50)

//定时器周期：1000ms
#define TIMER_PERIOD_1000MS      pdMS_TO_TICKS(1000)

#define TIMER_PERIOD_10MS      pdMS_TO_TICKS(10)

//蓝牙连接标志
bool g_ble_running_bean_connect = false;
bool g_ble_pad_connect          = false;


bool g_sleep_mode = false;
bool g_enter_sleep = false;

uint16_t g_flash_id = 0;
bool g_flash_ready = false;

extern uint32_t g_auto_power_off_cnt;

extern void bat_manager_init(void);
extern void lcd_display_init(void);
extern void bat_timer_handler(void);
void advertising_start(void);
void scan_start(void);
extern void timer_100ms_handle(TimerHandle_t xTimer);
extern void timer_50ms_handle(TimerHandle_t xTimer);
extern void task_sys_mng_handle(void * arg);
extern void timer_sport_handler(nrf_timer_event_t event_type, void * p_context);
extern void timer_10ms_handle(TimerHandle_t xTimer);

void task_sys_mng_Message_Send(uint8_t Message);

void time_init(void)
{
//    uint32_t test_count = rtc_counter_get();
    uint32_t enterTime = nrf_rtc_counter_get(portNRF_RTC_REG);

    NRF_LOG_INFO("time_init test_count = %d.", enterTime);
}

extern bool btime_syc_flag;

uint32_t ble_data_send(uint8_t* p_data, uint16_t p_length)
{
    uint32_t err_code = NRF_SUCCESS;

    do
    {
        err_code = ble_nus_data_send(&m_nus, p_data, &p_length, m_conn_handle);   //蓝牙协议栈转发数据
        if ( (err_code != NRF_ERROR_INVALID_STATE) && (err_code != NRF_ERROR_BUSY) &&
             (err_code != NRF_ERROR_NOT_FOUND) )
        {
            //APP_ERROR_CHECK(err_code);
//            NRF_LOG_INFO("err_code = %d", err_code);
        }
    } while ((err_code == NRF_ERROR_BUSY) || (err_code == NRF_ERROR_RESOURCES));
    
    return err_code;
}

uint32_t gh3x2x_ble_data_send(uint8_t* p_data, uint16_t p_length)
{
    uint32_t err_code = NRF_SUCCESS;
#if NRF_MODULE_ENABLED(BLE_GDX)

    do
    {
        err_code = ble_gdx_data_send(&m_gdx, p_data, &p_length, m_conn_handle);   //蓝牙协议栈转发数据
        if ( (err_code != NRF_ERROR_INVALID_STATE) && (err_code != NRF_ERROR_BUSY) &&
             (err_code != NRF_ERROR_NOT_FOUND) )
        {
            //APP_ERROR_CHECK(err_code);
//            NRF_LOG_INFO("err_code = %d", err_code);
        }
    } while ((err_code == NRF_ERROR_BUSY) || (err_code == NRF_ERROR_RESOURCES));
#endif
    return err_code;

}

//发送0xabcd,清除配对信息
void clear_paired_info(void)
{
    g_sysmng_info.u8BeanPaired = 0;
    
//    memcpy(g_sysmng_info.u8BeanName, bean_name, BEAN_NAME_LEN_MAX);
    memset(g_sysmng_info.u8BeanName, 0, BEAN_NAME_LEN_MAX);
    
    //保存默认信息
    Flash_Erase_Sector(SPI_FLASH_SYSINFO_ADDR_START);
    Flash_Write((uint8_t*)&g_sysmng_info, SPI_FLASH_SYSINFO_ADDR_START, sizeof(g_sysmng_info));
}

//发送0xaabb，设置手表id
void set_belt_id(uint16_t id)
{
    g_sysmng_info.belt_id = id;
    //保存默认信息
    Flash_Erase_Sector(SPI_FLASH_SYSINFO_ADDR_START);
    Flash_Write((uint8_t*)&g_sysmng_info, SPI_FLASH_SYSINFO_ADDR_START, sizeof(g_sysmng_info));
}

/**@brief Function for assert macro callback.
 *
 * @details This function will be called in case of an assert in the SoftDevice.
 *
 * @warning This handler is an example only and does not fit a final product. You need to analyse
 *          how your product is supposed to react in case of Assert.
 * @warning On assert from the SoftDevice, the system can only recover on reset.
 *
 * @param[in] line_num    Line number of the failing ASSERT call.
 * @param[in] p_file_name File name of the failing ASSERT call.
 */
void assert_nrf_callback(uint16_t line_num, const uint8_t * p_file_name)
{
    app_error_handler(DEAD_BEEF, line_num, p_file_name);
}


/**@brief Function for initializing the timer module.
 */
static void timers_init(void)//定时器初始化
{
#if 0
    ret_code_t err_code = app_timer_init();
    APP_ERROR_CHECK(err_code);
    
#endif
    
    // Create timers.
    timer_50ms = xTimerCreate("TIMER_20HZ", TIMER_PERIOD_50MS, pdTRUE, NULL, timer_50ms_handle);

    // Create timers.
    timer_100ms = xTimerCreate("TIMER_10HZ", TIMER_PERIOD_100MS, pdTRUE, NULL, timer_100ms_handle);

    // 运动使用 timers.
    timer_sport = xTimerCreate("TIMER_1HZ", TIMER_PERIOD_1000MS, pdTRUE, NULL, timer_sport_handler);

    //timer_10ms = xTimerCreate("TIMER_100HZ", TIMER_PERIOD_10MS, pdTRUE, NULL, timer_10ms_handle);

    /* Error checking */
    if ((NULL == timer_100ms) || (NULL == timer_sport) || (NULL == timer_50ms))//|| (NULL == timer_10ms))
    {
        APP_ERROR_HANDLER(NRF_ERROR_NO_MEM);
        return;
    }
    
    // Start application timers.
    if (pdPASS != xTimerStart(timer_100ms, 0))
    {
        APP_ERROR_HANDLER(NRF_ERROR_NO_MEM);
    }
    //xTimerStart(timer_10ms, 0);
}

/**@brief Function for the GAP initialization.
 *
 * @details This function will set up all the necessary GAP (Generic Access Profile) parameters of
 *          the device. It also sets the permissions and appearance.
 */
static void gap_params_init(void)//GAP初始化
{
    uint32_t                err_code;
    ble_gap_conn_params_t   gap_conn_params;
    ble_gap_conn_sec_mode_t sec_mode;

    BLE_GAP_CONN_SEC_MODE_SET_OPEN(&sec_mode);

    err_code = sd_ble_gap_device_name_set(&sec_mode,
                                          (const uint8_t *) DEVICE_NAME,
                                          strlen(DEVICE_NAME));
    APP_ERROR_CHECK(err_code);

    memset(&gap_conn_params, 0, sizeof(gap_conn_params));

    gap_conn_params.min_conn_interval = MIN_CONN_INTERVAL;
    gap_conn_params.max_conn_interval = MAX_CONN_INTERVAL;
    gap_conn_params.slave_latency     = SLAVE_LATENCY;
    gap_conn_params.conn_sup_timeout  = CONN_SUP_TIMEOUT;

    err_code = sd_ble_gap_ppcp_set(&gap_conn_params);
    APP_ERROR_CHECK(err_code);
}


/**@brief Function for handling Queued Write Module errors.
 *
 * @details A pointer to this function will be passed to each service which may need to inform the
 *          application about an error.
 *
 * @param[in]   nrf_error   Error code containing information about what went wrong.
 */
static void nrf_qwr_error_handler(uint32_t nrf_error)//队列写错误操作
{
    APP_ERROR_HANDLER(nrf_error);
}


/**@brief Function for handling the data from the Nordic UART Service.
 *
 * @details This function will process the data received from the Nordic UART BLE Service and send
 *          it to the UART module.
 *
 * @param[in] p_evt       Nordic UART Service event.
 */
/**@snippet [Handling the data received over BLE] */
static void nus_data_handler(ble_nus_evt_t * p_evt)//串口中断操作
{
//    NRF_LOG_INFO("nus_data_handler: handle = %d", p_evt->conn_handle);
//    NRF_LOG_INFO("nus_data_handler: type   = %d", p_evt->type);

    if (p_evt->type == BLE_NUS_EVT_RX_DATA)
    {
        uint32_t err_code;

        NRF_LOG_DEBUG("Received data from BLE NUS. Writing data on UART.");
        NRF_LOG_HEXDUMP_DEBUG(p_evt->params.rx_data.p_data, p_evt->params.rx_data.length);
        
        receive_cmd_handler((uint8_t*)p_evt->params.rx_data.p_data,p_evt->params.rx_data.length);
        //清除配对信息
	    if(0xab == p_evt->params.rx_data.p_data[0]&&
            0xcd == p_evt->params.rx_data.p_data[1])
        {
            clear_paired_info();
        } 
        //设置手环ID编号
        if(0xaa == p_evt->params.rx_data.p_data[0]&&
            0xbb == p_evt->params.rx_data.p_data[1])
        {
            uint16_t id = p_evt->params.rx_data.p_data[2];
            set_belt_id(id);
        }
        
        #if 1  //ACC测试程序
        if(0xaa == p_evt->params.rx_data.p_data[0]|
            0xb0 == p_evt->params.rx_data.p_data[1])
        {
            running_bean_data_handle(p_evt->params.rx_data.p_data, p_evt->params.rx_data.length);    
        }
        #endif
        
#if 0

        printbuf((uint8_t*)p_evt->params.rx_data.p_data, p_evt->params.rx_data.length);
        
        for (uint32_t i = 0; i < p_evt->params.rx_data.length; i++)
        {
            do
            {
                err_code = app_uart_put(p_evt->params.rx_data.p_data[i]);
                if ((err_code != NRF_SUCCESS) && (err_code != NRF_ERROR_BUSY))
                {
                    NRF_LOG_ERROR("Failed receiving NUS message. Error 0x%x. ", err_code);
                    APP_ERROR_CHECK(err_code);
                }
            } while (err_code == NRF_ERROR_BUSY);
        }
        if (p_evt->params.rx_data.p_data[p_evt->params.rx_data.length - 1] == '\r')
        {
            while (app_uart_put('\n') == NRF_ERROR_BUSY);
        }
#endif
    }
    else if (BLE_NUS_EVT_COMM_STARTED == p_evt->type)
    {
        NRF_LOG_INFO("BLE_NUS_EVT_COMM_STARTED.");
    }
    else if (BLE_NUS_EVT_COMM_STOPPED == p_evt->type)
    {
        NRF_LOG_INFO("BLE_NUS_EVT_COMM_STOPPED.");
    }

}

#if NRF_MODULE_ENABLED(BLE_GDX)
static void gdx_data_handler(ble_gdx_evt_t * p_evt) //心率调试用
{
    if (p_evt->type == BLE_GDX_EVT_RX_DATA)
    {
        uint32_t err_code;

        NRF_LOG_HEXDUMP_DEBUG(p_evt->params.rx_data.p_data, p_evt->params.rx_data.length);

        Gh3x2xDemoProtocolProcess(p_evt->params.rx_data.p_data, p_evt->params.rx_data.length);

    }
    else if (BLE_GDX_EVT_COMM_STARTED == p_evt->type)
    {
        NRF_LOG_INFO("BLE_GDX_EVT_COMM_STARTED.");
    }
    else if (BLE_GDX_EVT_COMM_STOPPED == p_evt->type)
    {
        NRF_LOG_INFO("BLE_GDX_EVT_COMM_STOPPED.");
    }

}
#endif

/**@snippet [Handling the data received over BLE] */



/**@brief Function for handling an event from the Connection Parameters Module.
 *
 * @details This function will be called for all events in the Connection Parameters Module
 *          which are passed to the application.
 *
 * @note All this function does is to disconnect. This could have been done by simply setting
 *       the disconnect_on_fail config parameter, but instead we use the event handler
 *       mechanism to demonstrate its use.
 *
 * @param[in] p_evt  Event received from the Connection Parameters Module.
 */
static void on_conn_params_evt(ble_conn_params_evt_t * p_evt)//连接参数事件
{
    uint32_t err_code;

    if (p_evt->evt_type == BLE_CONN_PARAMS_EVT_FAILED)
    {
        err_code = sd_ble_gap_disconnect(m_conn_handle, BLE_HCI_CONN_INTERVAL_UNACCEPTABLE);
        //APP_ERROR_CHECK(err_code);
    }
}


/**@brief Function for handling errors from the Connection Parameters module.
 *
 * @param[in] nrf_error  Error code containing information about what went wrong.
 */
static void conn_params_error_handler(uint32_t nrf_error)//连接参数错误
{
    APP_ERROR_HANDLER(nrf_error);
}


/**@brief Function for initializing the Connection Parameters module.
 */
static void conn_params_init(void)//连接参数初始化
{
    uint32_t               err_code;
    ble_conn_params_init_t cp_init;

    memset(&cp_init, 0, sizeof(cp_init));

    cp_init.p_conn_params                  = NULL;
    cp_init.first_conn_params_update_delay = FIRST_CONN_PARAMS_UPDATE_DELAY;
    cp_init.next_conn_params_update_delay  = NEXT_CONN_PARAMS_UPDATE_DELAY;
    cp_init.max_conn_params_update_count   = MAX_CONN_PARAMS_UPDATE_COUNT;
    cp_init.start_on_notify_cccd_handle    = BLE_GATT_HANDLE_INVALID;
    cp_init.disconnect_on_fail             = true;
    cp_init.evt_handler                    = on_conn_params_evt;
    cp_init.error_handler                  = conn_params_error_handler;

    err_code = ble_conn_params_init(&cp_init);
    APP_ERROR_CHECK(err_code);
}

void ble_disconnect_all(void)
{
    //主动断开蓝牙连接
    if (g_ble_running_bean_connect)
    {
        sd_ble_gap_disconnect(m_conn_handle_rb, BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
        m_conn_handle_rb            = BLE_CONN_HANDLE_INVALID;
        g_ble_running_bean_connect  = false;
    }

    if (g_ble_pad_connect)
    {
        sd_ble_gap_disconnect(m_conn_handle, BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
        g_ble_pad_connect   = false;
        m_conn_handle       = BLE_CONN_HANDLE_INVALID;
    }
}

/**@brief Function for handling advertising events.
 *
 * @details This function will be called for advertising events which are passed to the application.
 *
 * @param[in] ble_adv_evt  Advertising event.
 */
void on_adv_evt(ble_adv_evt_t ble_adv_evt)//广播事件
{
    uint32_t err_code;

    switch (ble_adv_evt)
    {
        case BLE_ADV_EVT_FAST:
            err_code = bsp_indication_set(BSP_INDICATE_ADVERTISING);
            APP_ERROR_CHECK(err_code);
            break;
        case BLE_ADV_EVT_IDLE:
//            sleep_mode_enter();
            break;
        default:
            break;
    }
}

/**@brief Function for handling the advertising report BLE event.
 *
 * @param[in] p_adv_report  Advertising report from the SoftDevice.
 */
static void on_adv_report(ble_gap_evt_adv_report_t const * p_adv_report)
{
    if (g_sleep_mode)
    {
        return;
    }
    
    ret_code_t err_code;
    bool ret = false;

    uint8_t bean_name[BEAN_NAME_LEN_MAX] = {'B', 'e', 'a', 'n', '-', 0};
    //已经匹配过跑步豆，需要使用匹配过的名称
    if (g_sysmng_info.u8BeanPaired)
    {
        memcpy(bean_name, g_sysmng_info.u8BeanName, BEAN_NAME_LEN_MAX);
    }
    
    ret = ble_advdata_name_find(p_adv_report->data.p_data, p_adv_report->data.len, bean_name);
//    ret = ble_advdata_uuid_find(p_adv_report->data.p_data, p_adv_report->data.len, &m_nus_uuid);
    
//    NRF_LOG_INFO("on_adv_report len = %d", p_adv_report->data.len);
//    NRF_LOG_INFO("on_adv_report ret = %d", ret);

//    if (ble_advdata_uuid_find(p_adv_report->data.p_data, p_adv_report->data.len, &m_nus_uuid))
    if (ret)
    {
        err_code = sd_ble_gap_connect(&p_adv_report->peer_addr,
                                      &m_scan_params,
                                      &m_connection_param,
                                      APP_BLE_CONN_CFG_TAG);

        if (err_code == NRF_SUCCESS)
        {
            // scan is automatically stopped by the connect
            err_code = bsp_indication_set(BSP_INDICATE_IDLE);
            APP_ERROR_CHECK(err_code);
            NRF_LOG_INFO("Connecting to target %02x%02x%02x%02x%02x%02x",
                     p_adv_report->peer_addr.addr[0],
                     p_adv_report->peer_addr.addr[1],
                     p_adv_report->peer_addr.addr[2],
                     p_adv_report->peer_addr.addr[3],
                     p_adv_report->peer_addr.addr[4],
                     p_adv_report->peer_addr.addr[5]
                     );

            if (0 == g_sysmng_info.u8BeanPaired)
            {
                //保持匹配的跑步豆信息
                g_sysmng_info.u8BeanPaired = 1;

                memcpy(g_sysmng_info.u8BeanName, bean_name, BEAN_NAME_LEN_MAX);
                
                //保存默认信息
                Flash_Erase_Sector(SPI_FLASH_SYSINFO_ADDR_START);
                Flash_Write((uint8_t*)&g_sysmng_info, SPI_FLASH_SYSINFO_ADDR_START, sizeof(g_sysmng_info));
            }
        }
    }
    else
    {
        err_code = sd_ble_gap_scan_start(NULL, &m_scan_buffer);
        APP_ERROR_CHECK(err_code);
    }
}

static void ble_evt_c_handler(ble_evt_t const * p_ble_evt, void * p_context)//蓝牙处理事件
{
    uint32_t err_code;
    ble_gap_evt_t const * p_gap_evt = &p_ble_evt->evt.gap_evt;
    
    uint16_t conn_handle = p_ble_evt->evt.gap_evt.conn_handle;
    uint16_t role        = ble_conn_state_role(conn_handle);

    switch (p_ble_evt->header.evt_id)
    {
    #if 0
        case BLE_GATTC_EVT_HVX:
        {
//            NRF_LOG_INFO("evt len = %d", p_ble_evt->header.evt_len);
//            printbuf((uint8_t*)&(p_ble_evt->evt.gattc_evt), p_ble_evt->header.evt_len);

            uint8_t sendbuf[10] = {0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a };
            ble_data_send(sendbuf, 10);
        }
        break;
    #endif
        case BLE_GAP_EVT_ADV_REPORT:
            on_adv_report(&p_gap_evt->params.adv_report);
            break; // BLE_GAP_EVT_ADV_REPORT

        case BLE_GAP_EVT_CONNECTED:
            NRF_LOG_INFO("Connected to target");
            err_code = ble_nus_c_handles_assign(&m_ble_nus_c, p_ble_evt->evt.gap_evt.conn_handle, NULL);
            APP_ERROR_CHECK(err_code);

            m_conn_handle_rb            = p_ble_evt->evt.gap_evt.conn_handle;
            g_ble_running_bean_connect  = true;
            ble_rb_connect_state_notify(true);

//            err_code = bsp_indication_set(BSP_INDICATE_CONNECTED);
//            APP_ERROR_CHECK(err_code);

            // start discovery of services. The NUS Client waits for a discovery result
//            err_code = ble_db_discovery_start(&m_db_disc, p_ble_evt->evt.gap_evt.conn_handle);
//            APP_ERROR_CHECK(err_code);
            break;

        case BLE_GAP_EVT_TIMEOUT:
            if (p_gap_evt->params.timeout.src == BLE_GAP_TIMEOUT_SRC_SCAN)
            {
                NRF_LOG_INFO("Scan timed out.");
                scan_start();
            }
            else if (p_gap_evt->params.timeout.src == BLE_GAP_TIMEOUT_SRC_CONN)
            {
                NRF_LOG_INFO("Connection Request timed out.");
            }
            break;

        case BLE_GAP_EVT_SEC_PARAMS_REQUEST:
            // Pairing not supported
            err_code = sd_ble_gap_sec_params_reply(p_ble_evt->evt.gap_evt.conn_handle, BLE_GAP_SEC_STATUS_PAIRING_NOT_SUPP, NULL, NULL);
            APP_ERROR_CHECK(err_code);
            break;

        case BLE_GAP_EVT_CONN_PARAM_UPDATE_REQUEST:
            // Accepting parameters requested by peer.
            err_code = sd_ble_gap_conn_param_update(p_gap_evt->conn_handle,
                                                    &p_gap_evt->params.conn_param_update_request.conn_params);
            APP_ERROR_CHECK(err_code);
            break;

        case BLE_GAP_EVT_PHY_UPDATE_REQUEST:
        {
            NRF_LOG_DEBUG("PHY update request.");
            ble_gap_phys_t const phys =
            {
                .rx_phys = BLE_GAP_PHY_AUTO,
                .tx_phys = BLE_GAP_PHY_AUTO,
            };
            err_code = sd_ble_gap_phy_update(p_ble_evt->evt.gap_evt.conn_handle, &phys);
            APP_ERROR_CHECK(err_code);
        } break;

        case BLE_GATTC_EVT_TIMEOUT:
            // Disconnect on GATT Client timeout event.
            NRF_LOG_DEBUG("GATT Client Timeout.");
            err_code = sd_ble_gap_disconnect(p_ble_evt->evt.gattc_evt.conn_handle,
                                             BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
            APP_ERROR_CHECK(err_code);
            
            m_conn_handle_rb            = BLE_CONN_HANDLE_INVALID;
            g_ble_running_bean_connect  = false;
            ble_rb_connect_state_notify(false);
            break;

        case BLE_GATTS_EVT_TIMEOUT:
            // Disconnect on GATT Server timeout event.
            NRF_LOG_DEBUG("GATT Server Timeout.");
            err_code = sd_ble_gap_disconnect(p_ble_evt->evt.gatts_evt.conn_handle,
                                             BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
            APP_ERROR_CHECK(err_code);

            m_conn_handle_rb            = BLE_CONN_HANDLE_INVALID;
            g_ble_running_bean_connect  = false;
            ble_rb_connect_state_notify(false);
            break;

        default:
            break;
    }
}


static void ble_evt_p_handler(ble_evt_t const * p_ble_evt, void * p_context)//蓝牙处理事件
{
    uint32_t err_code;
    ble_gap_evt_t const * p_gap_evt = &p_ble_evt->evt.gap_evt;
    
    uint16_t conn_handle = p_ble_evt->evt.gap_evt.conn_handle;
    uint16_t role        = ble_conn_state_role(conn_handle);
    
    //NRF_LOG_INFO("p_ble_evt->header.evt_id = %d", p_ble_evt->header.evt_id);

    switch (p_ble_evt->header.evt_id)
    {
        case BLE_GAP_EVT_CONNECTED:
            NRF_LOG_INFO("Connected");
//            err_code = bsp_indication_set(BSP_INDICATE_CONNECTED);
//            APP_ERROR_CHECK(err_code);
            m_conn_handle = p_ble_evt->evt.gap_evt.conn_handle;
            err_code = nrf_ble_qwr_conn_handle_assign(&m_qwr, m_conn_handle);
            APP_ERROR_CHECK(err_code);

            ble_pad_connect_state_notify(true);

            g_ble_pad_connect = true;
            
            err_code = sd_ble_gap_tx_power_set(BLE_GAP_TX_POWER_ROLE_CONN, g_ble_pad_connect, 8);
            APP_ERROR_CHECK(err_code);
            
            break;
        case BLE_GAP_EVT_DISCONNECTED:
            NRF_LOG_INFO("Disconnected");
            
            g_ble_pad_connect = false;
            ble_pad_connect_state_notify(false);

            // LED indication will be changed when advertising starts.
            m_conn_handle = BLE_CONN_HANDLE_INVALID;
            break;

        case BLE_GAP_EVT_PHY_UPDATE_REQUEST:
        {
            NRF_LOG_INFO("PHY update request.");
            NRF_LOG_DEBUG("PHY update request.");
            ble_gap_phys_t const phys =
            {
                .rx_phys = BLE_GAP_PHY_AUTO,
                .tx_phys = BLE_GAP_PHY_AUTO,
            };
            err_code = sd_ble_gap_phy_update(p_ble_evt->evt.gap_evt.conn_handle, &phys);
            APP_ERROR_CHECK(err_code);
        } break;

        case BLE_GAP_EVT_SEC_PARAMS_REQUEST:
            // Pairing not supported
            err_code = sd_ble_gap_sec_params_reply(p_ble_evt->evt.gap_evt.conn_handle, BLE_GAP_SEC_STATUS_PAIRING_NOT_SUPP, NULL, NULL);
            APP_ERROR_CHECK(err_code);
            break;

        case BLE_GATTS_EVT_SYS_ATTR_MISSING:
            // No system attributes have been stored.
            err_code = sd_ble_gatts_sys_attr_set(p_ble_evt->evt.gap_evt.conn_handle, NULL, 0, 0);
            APP_ERROR_CHECK(err_code);
            break;

        case BLE_GATTC_EVT_TIMEOUT:
            // Disconnect on GATT Client timeout event.
            err_code = sd_ble_gap_disconnect(p_ble_evt->evt.gattc_evt.conn_handle,
                                             BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
            APP_ERROR_CHECK(err_code);
            g_ble_pad_connect   = false;
            m_conn_handle       = BLE_CONN_HANDLE_INVALID;
            break;

        case BLE_GATTS_EVT_TIMEOUT:
            // Disconnect on GATT Server timeout event.
            err_code = sd_ble_gap_disconnect(p_ble_evt->evt.gatts_evt.conn_handle,
                                             BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
            APP_ERROR_CHECK(err_code);
            g_ble_pad_connect   = false;
            m_conn_handle       = BLE_CONN_HANDLE_INVALID;
            break;

        default:
            // No implementation needed.
            break;
    }
}

/**@brief Function for checking if a bluetooth stack event is an advertising timeout.
 *
 * @param[in] p_ble_evt Bluetooth stack event.
 */
static bool ble_evt_is_advertising_timeout(ble_evt_t const * p_ble_evt)
{
    return (p_ble_evt->header.evt_id == BLE_GAP_EVT_ADV_SET_TERMINATED);
}


/**@brief Function for handling BLE events.
 *
 * @param[in]   p_ble_evt   Bluetooth stack event.
 * @param[in]   p_context   Unused.
 */
static void ble_evt_handler(ble_evt_t const * p_ble_evt, void * p_context)//蓝牙处理事件
{
    uint32_t err_code;
    ble_gap_evt_t const * p_gap_evt = &p_ble_evt->evt.gap_evt;
    
    uint16_t conn_handle = p_ble_evt->evt.gap_evt.conn_handle;
    uint16_t role        = ble_conn_state_role(conn_handle);
    
//    NRF_LOG_INFO("ble_evt_handler role = %d", role);
//    NRF_LOG_INFO("ble_evt_handler evt = %d", p_ble_evt->header.evt_id);


    // Based on the role this device plays in the connection, dispatch to the right handler.
    if (role == BLE_GAP_ROLE_PERIPH || ble_evt_is_advertising_timeout(p_ble_evt))
    {
        ble_evt_p_handler(p_ble_evt, p_context);
    }
    else if ((role == BLE_GAP_ROLE_CENTRAL) || (p_ble_evt->header.evt_id == BLE_GAP_EVT_ADV_REPORT))
    {
        ble_evt_c_handler(p_ble_evt, p_context);
    }
}


/**@brief Function for the SoftDevice initialization.
 *
 * @details This function initializes the SoftDevice and the BLE event interrupt.
 */
static void ble_stack_init(void)//协议栈初始化
{
    ret_code_t err_code;

    err_code = nrf_sdh_enable_request();
    APP_ERROR_CHECK(err_code);

    // Configure the BLE stack using the default settings.
    // Fetch the start address of the application RAM.
    uint32_t ram_start = 0;
    err_code = nrf_sdh_ble_default_cfg_set(APP_BLE_CONN_CFG_TAG, &ram_start);
    APP_ERROR_CHECK(err_code);

    // Enable BLE stack.
    err_code = nrf_sdh_ble_enable(&ram_start);
    APP_ERROR_CHECK(err_code);

    // Register a handler for BLE events.
    NRF_SDH_BLE_OBSERVER(m_ble_observer, APP_BLE_OBSERVER_PRIO, ble_evt_handler, NULL);
}


/**@brief Function for handling events from the GATT library. */
void gatt_evt_handler(nrf_ble_gatt_t * p_gatt, nrf_ble_gatt_evt_t const * p_evt)//GATT事件处理函数
{
    if ((m_conn_handle == p_evt->conn_handle) && (p_evt->evt_id == NRF_BLE_GATT_EVT_ATT_MTU_UPDATED))
    {
        m_ble_nus_max_data_len = p_evt->params.att_mtu_effective - OPCODE_LENGTH - HANDLE_LENGTH;
        NRF_LOG_INFO("Data len is set to 0x%X(%d)", m_ble_nus_max_data_len, m_ble_nus_max_data_len);
    }
    NRF_LOG_DEBUG("ATT MTU exchange completed. central 0x%x peripheral 0x%x",
                  p_gatt->att_mtu_desired_central,
                  p_gatt->att_mtu_desired_periph);
}


/**@brief Function for initializing the GATT library. */
void gatt_init(void)//GATT初始化
{
    ret_code_t err_code;

    err_code = nrf_ble_gatt_init(&m_gatt, gatt_evt_handler);
    APP_ERROR_CHECK(err_code);

    err_code = nrf_ble_gatt_att_mtu_periph_set(&m_gatt, BLE_GATT_ATT_MTU_DEFAULT);
    APP_ERROR_CHECK(err_code);
}


/**@brief Function for handling events from the BSP module.
 *
 * @param[in]   event   Event generated by button press.
 */
void bsp_event_handler(bsp_event_t event)//板级处理事件
{
    uint32_t err_code;
    switch (event)
    {
        case BSP_EVENT_KEY_0:
        {
            NRF_LOG_INFO("press key");

#if NRF_MODULE_ENABLED(BLE_GDX)

            static bool hr_flag = false;

            if (hr_flag)
            {
                hr_task_msg_send(HR_EVT_STOP_MEASURE);
                hr_flag = false;
            }
            else
            {
                hr_task_msg_send(HR_EVT_START_MEASURE);
                hr_flag = true;
            }
#endif
        }
        break;

        case BSP_EVENT_PRESS_RELEASE:
        {
            NRF_LOG_INFO("press release");
            if (g_sleep_mode)
            {
                g_enter_sleep = true;
            }
            
        }
        break;

        case BSP_EVENT_SHORT_PRESS:
        {
            NRF_LOG_INFO("short press");

#if 0
            static uint8_t voice_index = 0;
            audio_play(voice_index);
            if (++voice_index >= voice_max)
            {
                voice_index = 0;
            }
#endif
        }
        break;

        case BSP_EVENT_LONG_PRESS:
        {
            NRF_LOG_INFO("long press");
//            sleep_mode_enter();
#if 0
            //上课状态或数据同步中不做自动休眠关机
            if (allow_sleep())
            {
                g_sleep_mode = true;
                g_enter_sleep = false;
                g_auto_power_off_cnt = POWER_OFF_TIME_CNT;
            }
#endif
            //上课中，先自动结束上课，然后再关机
            if (1 == m_bracelet_state.pe_state)
            {
                class_end();

                g_sleep_mode = true;
                g_enter_sleep = false;
                g_auto_power_off_cnt = POWER_OFF_TIME_CNT;
                
            }
            //数据同步中，不允许关机
            else if (3 == m_bracelet_state.pe_state)
            {
            }
            //直接关机
            else
            {
                g_sleep_mode = true;
                g_enter_sleep = false;
                g_auto_power_off_cnt = POWER_OFF_TIME_CNT;
            }

        }
        break;
        
        case BSP_EVENT_SLEEP:
        {
            NRF_LOG_INFO("BSP_EVENT_SLEEP");
//            sleep_mode_enter();
        }
        break;

        case BSP_EVENT_DISCONNECT:
            err_code = sd_ble_gap_disconnect(m_conn_handle, BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
            if (err_code != NRF_ERROR_INVALID_STATE)
            {
                APP_ERROR_CHECK(err_code);
            }
            break;

        case BSP_EVENT_WHITELIST_OFF:
            if (m_conn_handle == BLE_CONN_HANDLE_INVALID)
            {
                err_code = ble_advertising_restart_without_whitelist(&m_advertising);
                if (err_code != NRF_ERROR_INVALID_STATE)
                {
                    APP_ERROR_CHECK(err_code);
                }
            }
            break;

        default:
            break;
    }
}


/**@brief   Function for handling app_uart events.
 *
 * @details This function will receive a single character from the app_uart module and append it to
 *          a string. The string will be be sent over BLE when the last character received was a
 *          'new line' '\n' (hex 0x0A) or if the string has reached the maximum data length.
 */
/**@snippet [Handling the data received over UART] */
void uart_event_handle(app_uart_evt_t * p_event)
{
//    static uint8_t data_array[BLE_NUS_MAX_DATA_LEN];
//    static uint8_t index = 0;

    uint8_t     rec_data = 0;
    
    uint32_t    err_code = NRF_SUCCESS;

    switch (p_event->evt_type)
    {
        case APP_UART_DATA_READY:
        {
            UNUSED_VARIABLE(app_uart_get(&rec_data)); //接收串口数据

//            NRF_LOG_INFO("app_uart_get data = 0x%.2x", rec_data);

           
            #if 0
            index++;

            if ((data_array[index - 1] == '\n') || (index >= (m_ble_nus_max_data_len)))
            {
                NRF_LOG_DEBUG("Ready to send data over BLE NUS");
                NRF_LOG_HEXDUMP_DEBUG(data_array, index);

                do
                {
                    uint16_t length = (uint16_t)index;
                    err_code = ble_nus_data_send(&m_nus, data_array, &length, m_conn_handle);   //蓝牙协议栈转发数据
                    if ( (err_code != NRF_ERROR_INVALID_STATE) && (err_code != NRF_ERROR_BUSY) &&
                         (err_code != NRF_ERROR_NOT_FOUND) )
                    {
                        APP_ERROR_CHECK(err_code);
                    }
                } while (err_code == NRF_ERROR_BUSY);

                index = 0;
            }
            #endif
        }
        break;

        case APP_UART_COMMUNICATION_ERROR:
            //APP_ERROR_HANDLER(p_event->data.error_communication);
            break;

        case APP_UART_FIFO_ERROR:
            //APP_ERROR_HANDLER(p_event->data.error_code);
            break;

        case APP_UART_TX_EMPTY:
            //APP_ERROR_HANDLER(p_event->data.error_code);
            break;

        default:
            break;
    }
}
/**@snippet [Handling the data received over UART] */

#if 0
/**@brief  Function for initializing the UART module.
 */
/**@snippet [UART Initialization] */
static void uart_init(void)
{
    uint32_t                     err_code;

    //串口，对接心率处理和总台MCU，两个功能都是单向处理数据，因此暂时共用串口
    //接收端对接PPG心率数据，发送端对接总台MCU
    app_uart_comm_params_t const comm_params =
    {
        .rx_pin_no    = PPT_RX_PIN_NUMBER,
        .tx_pin_no    = MCU_TX_PIN_NUMBER,
        .rts_pin_no   = RTS_PIN_NUMBER,
        .cts_pin_no   = CTS_PIN_NUMBER,
        .flow_control = APP_UART_FLOW_CONTROL_DISABLED,
        .use_parity   = false,
#if defined (UART_PRESENT)
        .baud_rate    = NRF_UART_BAUDRATE_9600
#else
        .baud_rate    = NRF_UARTE_BAUDRATE_9600
#endif
    };

    APP_UART_FIFO_INIT(&comm_params,
                       UART_RX_BUF_SIZE,
                       UART_TX_BUF_SIZE,
                       uart_event_handle,		//串口数据回调处理
                       APP_IRQ_PRIORITY_LOWEST,
                       err_code);
    APP_ERROR_CHECK(err_code);

}
/**@snippet [UART Initialization] */
#endif


void adv_update(void)
{
    //停止广播
    sd_ble_gap_adv_stop(m_advertising.adv_handle);

    //定义广播初始化配置结构体变量
    ble_advdata_manuf_data_t adv_data;

    prepare_adv_data();
    
    //adv_data.company_identifier     = belt_id;
    adv_data.company_identifier     = 0x0000;
    
    adv_data.data.size              = sizeof(g_adv_data_buf);
    adv_data.data.p_data            = (uint8_t*)&g_adv_data_buf;
    
    adv_config.advdata.p_manuf_specific_data = &adv_data;
    
    adv_config.advdata.flags = BLE_GAP_ADV_FLAGS_LE_ONLY_GENERAL_DISC_MODE;
    adv_config.srdata.name_type = BLE_ADVDATA_FULL_NAME;
    
    
    ble_advertising_advdata_update(&m_advertising, &adv_config.advdata, &adv_config.srdata);

    advertising_start();
}

/**@brief Function for initializing the Advertising functionality.
 */
int8_t                  tx_power = 8;
static void advertising_init(void)
{
    tx_power = 8;
    uint32_t                err_code;

    ble_advdata_manuf_data_t adv_data = {0};

    //配置之前先清零
    memset(&adv_config, 0, sizeof(adv_config));

    memset(&g_adv_data_buf, 0, sizeof(g_adv_data_buf));
    

#if 0
    ble_advertising_init_t  init;
    memset(&init, 0, sizeof(init));
#endif
#if 1
    ble_gap_addr_t addr;
    err_code = sd_ble_gap_addr_get(&addr);
//    APP_ERROR_CHECK(err_code);

    // Increase the BLE address by one when advertising openly.
    //addr.addr[0] = 0x34;
    //addr.addr[1] = 0x8d;
    //addr.addr[2] = 0x95;
    addr.addr[3] = 0xFD;
    addr.addr[4] = 0x80;
    addr.addr[5] = 0xFA;

    err_code = sd_ble_gap_addr_set(&addr);
//    APP_ERROR_CHECK(err_code);
#endif
#if 0
    init.advdata.name_type          = BLE_ADVDATA_FULL_NAME;
    init.advdata.include_appearance = false;
    init.advdata.p_tx_power_level   = &tx_power;
    init.advdata.flags              = BLE_GAP_ADV_FLAGS_LE_ONLY_GENERAL_DISC_MODE;

    init.srdata.uuids_complete.uuid_cnt = sizeof(m_adv_uuids) / sizeof(m_adv_uuids[0]);
    init.srdata.uuids_complete.p_uuids  = m_adv_uuids;

    init.config.ble_adv_fast_enabled  = true;
    init.config.ble_adv_fast_interval = APP_ADV_INTERVAL;
    init.config.ble_adv_fast_timeout  = APP_ADV_DURATION;
    init.evt_handler = on_adv_evt;
#endif


    g_adv_data_buf.version      = 0x02;

    
    prepare_adv_data();

    adv_data.company_identifier     = belt_id;      //注意大小端

    adv_data.data.size              = sizeof(g_adv_data_buf);
    adv_data.data.p_data            = (uint8_t*)&g_adv_data_buf;


    adv_config.config.ble_adv_fast_enabled  = true;
    adv_config.config.ble_adv_fast_interval = APP_ADV_INTERVAL;
    adv_config.config.ble_adv_fast_timeout  = APP_ADV_DURATION;
    adv_config.evt_handler = on_adv_evt;

    adv_config.advdata.p_manuf_specific_data = &adv_data;

    adv_config.advdata.flags = BLE_GAP_ADV_FLAGS_LE_ONLY_GENERAL_DISC_MODE;
    adv_config.srdata.name_type = BLE_ADVDATA_FULL_NAME;

    err_code = ble_advertising_init(&m_advertising, &adv_config);
    APP_ERROR_CHECK(err_code);

    ble_advertising_conn_cfg_tag_set(&m_advertising, APP_BLE_CONN_CFG_TAG);
}

/**@brief Function for initializing buttons and leds.
 *
 * @param[out] p_erase_bonds  Will be true if the clear bonding button was pressed to wake the application up.
 */
static void buttons_leds_init(bool * p_erase_bonds)
{
    bsp_event_t startup_event;

    uint32_t err_code = bsp_init(BSP_INIT_BUTTONS, bsp_event_handler);
    APP_ERROR_CHECK(err_code);
#if 0
    err_code = bsp_btn_ble_init(NULL, &startup_event);
    APP_ERROR_CHECK(err_code);

    *p_erase_bonds = (startup_event == BSP_EVENT_CLEAR_BONDING_DATA);
#endif
}


/**@brief Function for initializing the nrf log module.
 */
static void log_init(void)
{
    ret_code_t err_code = NRF_LOG_INIT(NULL);
    APP_ERROR_CHECK(err_code);

    NRF_LOG_DEFAULT_BACKENDS_INIT();
}


/**@brief Function for initializing power management.
 */
static void power_management_init(void)
{
    ret_code_t err_code;
    err_code = nrf_pwr_mgmt_init();
    APP_ERROR_CHECK(err_code);
}


/**@brief Function for handling the idle state (main loop).
 *
 * @details If there is no pending log operation, then sleep until next the next event occurs.
 */
static void idle_state_handle(void)
{
    UNUSED_RETURN_VALUE(NRF_LOG_PROCESS());
    nrf_pwr_mgmt_run();
}


/**@brief Function for starting advertising.
 */
void advertising_start(void)
{
    uint32_t err_code = ble_advertising_start(&m_advertising, BLE_ADV_MODE_FAST);
//    APP_ERROR_CHECK(err_code);
}


#if 0
void display_update(void)
{
	if (NULL == Lable_heart)
	{
		return;
	}

	static uint8_t heart_value = 40;
	char strbuf[10] = {0};

	if (heart_value++ > 180)
	{
		heart_value = 40;
	}

//	heart_value = random(40, 180);

	sprintf(strbuf, "%d", heart_value);
	lv_label_set_text(Lable_heart, strbuf);
}

void lv_display_creat(void)
{
	//创建lable，显示心率值用
	if (NULL == Lable_heart)
	{
		Lable_heart = lv_label_create(NULL, NULL);
		
		if (NULL == Lable_heart)
		{
			return;
		}
	}
	lv_label_set_text(Lable_heart, "80");
	lv_obj_align(Lable_heart, NULL, LV_ALIGN_CENTER, 0, 0);

	/* Create an `lv_task` to update the arc.
	* Store the `arc` in the user data*/
	lv_task_create(display_update, 100, LV_TASK_PRIO_LOWEST, NULL);
}
#endif

void flash_init(void)
{
    NRF_LOG_INFO("flash_init");

	//spi init 
	SPI_Flash_Init();
	
	//退出power down 模式
//	SpiFlash_release_power_down();
    Flash_release_power_down();

	
	g_flash_id = Flash_ReadID();
	if (W25Q128_ID == g_flash_id)
	{
	    g_flash_ready = true;
	}
	NRF_LOG_INFO(" the flash id = 0x%x, g_flash_ready = %d", g_flash_id, g_flash_ready);

#if 0
    flash_test();
#endif

    
}



#if NRF_LOG_ENABLED
/**@brief Thread for handling the logger.
 *
 * @details This thread is responsible for processing log entries if logs are deferred.
 *          Thread flushes all log entries and suspends. It is resumed by idle task hook.
 *
 * @param[in]   arg   Pointer used for passing some arbitrary information (context) from the
 *                    osThreadCreate() call to the thread.
 */
static void task_logger_handle(void * arg)
{
    UNUSED_PARAMETER(arg);

    while (1)
    {
        NRF_LOG_FLUSH();

        vTaskSuspend(NULL); // Suspend myself
    }
}
#endif //NRF_LOG_ENABLED

/**@brief A function which is hooked to idle task.
 * @note Idle hook must be enabled in FreeRTOS configuration (configUSE_IDLE_HOOK).
 */
void vApplicationIdleHook( void )
{
}

void vApplicationTickHook(void)
{
    NRF_LOG_INFO("vApplicationTickHook.");
}

void vApplicationMallocFailedHook(void)
{
    NRF_LOG_INFO("vApplicationMallocFailedHook.");
}

void vApplicationStackOverflowHook( TaskHandle_t xTask, char *pcTaskName )
{
    NRF_LOG_INFO("vApplicationStackOverflowHook: %s.", pcTaskName);
}



//*****************************************************************************
// * 函 数 名  : application_init
// * 函数功能  : 应用程序功能初始化
// * 输入参数  :	 无
// * 输出参数  : 无
// * 返 回 值  : 无
//*****************************************************************************/
void application_init( void )
{
    // 屏幕刷新任务.
    if (pdPASS != xTaskCreate(task_display_handle, "display", 2048, NULL, 3, &task_display_thread))
    {
        APP_ERROR_HANDLER(NRF_ERROR_NO_MEM);
    }

    // 音频播放任务.
    if (pdPASS != xTaskCreate(task_audio_play_handle, "play", 1024, NULL, 2, &task_audio_play_thread))
    {
        APP_ERROR_HANDLER(NRF_ERROR_NO_MEM);
    }

    // 设备管理主任务.
    if (pdPASS != xTaskCreate(task_sys_mng_handle, "sys_mng", (2*1024), NULL, 3, &task_sys_mng_thread))
    {
        APP_ERROR_HANDLER(NRF_ERROR_NO_MEM);
    }

    // 训练任务.
    if (pdPASS != xTaskCreate(task_train_handle, "train", (4*1024), NULL, 3, &task_train_thread))
    {
        APP_ERROR_HANDLER(NRF_ERROR_NO_MEM);
    }

    // 心率任务.
    if (pdPASS != xTaskCreate(hr_main_task, "hr", 8192, NULL, 3, &task_hr_thread))
    {
        APP_ERROR_HANDLER(NRF_ERROR_NO_MEM);
    }
		
    // Start FreeRTOS scheduler.
    vTaskStartScheduler();

}

static void log_resetreason(void)
{
    /* Reset reason */
    uint32_t rr = nrf_power_resetreas_get();
    NRF_LOG_INFO("Reset reasons:");
    if (0 == rr)
    {
        NRF_LOG_INFO("- NONE");
    }
    if (0 != (rr & NRF_POWER_RESETREAS_RESETPIN_MASK))
    {
        NRF_LOG_INFO("- RESETPIN");
    }
    if (0 != (rr & NRF_POWER_RESETREAS_DOG_MASK     ))
    {
        NRF_LOG_INFO("- DOG");
    }
    if (0 != (rr & NRF_POWER_RESETREAS_SREQ_MASK    ))
    {
        NRF_LOG_INFO("- SREQ");
    }
    if (0 != (rr & NRF_POWER_RESETREAS_LOCKUP_MASK  ))
    {
        NRF_LOG_INFO("- LOCKUP");
    }
    if (0 != (rr & NRF_POWER_RESETREAS_OFF_MASK     ))
    {
        NRF_LOG_INFO("- OFF");
    }
    if (0 != (rr & NRF_POWER_RESETREAS_LPCOMP_MASK  ))
    {
        NRF_LOG_INFO("- LPCOMP");
    }
    if (0 != (rr & NRF_POWER_RESETREAS_DIF_MASK     ))
    {
        NRF_LOG_INFO("- DIF");
    }
    if (0 != (rr & NRF_POWER_RESETREAS_NFC_MASK     ))
    {
        NRF_LOG_INFO("- NFC");
    }
    if (0 != (rr & NRF_POWER_RESETREAS_VBUS_MASK    ))
    {
        NRF_LOG_INFO("- VBUS");
    }

//    nrf_power_resetreas_clear(0);
}

void scan_start(void)
{
    if (g_sleep_mode)
    {
        return;
    }
    
    ret_code_t ret;

    ret = sd_ble_gap_scan_start(&m_scan_params, &m_scan_buffer);
    APP_ERROR_CHECK(ret);

//    ret = bsp_indication_set(BSP_INDICATE_SCANNING);
//    APP_ERROR_CHECK(ret);
}

static void ble_nus_chars_received_uart_print(uint8_t * p_data, uint16_t data_len)
{
    ret_code_t ret_val;

    NRF_LOG_DEBUG("Receiving data.");
    NRF_LOG_HEXDUMP_DEBUG(p_data, data_len);

    for (uint32_t i = 0; i < data_len; i++)
    {
        do
        {
            ret_val = app_uart_put(p_data[i]);
            if ((ret_val != NRF_SUCCESS) && (ret_val != NRF_ERROR_BUSY))
            {
                NRF_LOG_ERROR("app_uart_put failed for index 0x%04x.", i);
                APP_ERROR_CHECK(ret_val);
            }
        } while (ret_val == NRF_ERROR_BUSY);
    }
    if (p_data[data_len-1] == '\r')
    {
        while (app_uart_put('\n') == NRF_ERROR_BUSY);
    }
    if (ECHOBACK_BLE_UART_DATA)
    {
        // Send data back to peripheral.
        do
        {
            ret_val = ble_nus_c_string_send(&m_ble_nus_c, p_data, data_len);
            if ((ret_val != NRF_SUCCESS) && (ret_val != NRF_ERROR_BUSY))
            {
                NRF_LOG_ERROR("Failed sending NUS message. Error 0x%x. ", ret_val);
                APP_ERROR_CHECK(ret_val);
            }
        } while (ret_val == NRF_ERROR_BUSY);
    }
}


static void ble_nus_c_evt_handler(ble_nus_c_t * p_ble_nus_c, ble_nus_c_evt_t const * p_ble_nus_evt)
{
    ret_code_t err_code;

    switch (p_ble_nus_evt->evt_type)
    {
        case BLE_NUS_C_EVT_DISCOVERY_COMPLETE:
            NRF_LOG_INFO("Discovery complete.");
            NRF_LOG_INFO("conn_handle = %d", p_ble_nus_evt->conn_handle);
            NRF_LOG_INFO("nus_tx_cccd_handle = %d", p_ble_nus_evt->handles.nus_tx_cccd_handle);
            err_code = ble_nus_c_handles_assign(p_ble_nus_c, p_ble_nus_evt->conn_handle, &p_ble_nus_evt->handles);
            APP_ERROR_CHECK(err_code);

            err_code = ble_nus_c_tx_notif_enable(p_ble_nus_c);
            APP_ERROR_CHECK(err_code);
            NRF_LOG_INFO("Connected to device with Nordic UART Service.");
            break;

        case BLE_NUS_C_EVT_NUS_TX_EVT:
//            NRF_LOG_INFO("ble_nus_c_evt_handler len = %d", p_ble_nus_evt->data_len);

            running_bean_data_handle(p_ble_nus_evt->p_data, p_ble_nus_evt->data_len);
//            ble_nus_chars_received_uart_print(p_ble_nus_evt->p_data, p_ble_nus_evt->data_len);
            break;

        case BLE_NUS_C_EVT_DISCONNECTED:
            NRF_LOG_INFO("Disconnected.");
            m_conn_handle_rb            = BLE_CONN_HANDLE_INVALID;
            g_ble_running_bean_connect  = false;
            scan_start();
            break;
    }
}

static void db_disc_handler(ble_db_discovery_evt_t * p_evt)
{
    ble_nus_c_on_db_disc_evt(&m_ble_nus_c, p_evt);
}


/**
 * @brief Database discovery initialization.
 */
static void db_discovery_init(void)
{
    ret_code_t err_code = ble_db_discovery_init(db_disc_handler);
    APP_ERROR_CHECK(err_code);
}

/**@brief Function for initializing the NUS Client. */
static void nus_c_init(void)
{
    ret_code_t       err_code;
    ble_nus_c_init_t init;

    init.evt_handler = ble_nus_c_evt_handler;

    err_code = ble_nus_c_init(&m_ble_nus_c, &init);
    APP_ERROR_CHECK(err_code);
}
/**@brief Function for changing the tx power.
 */
#define TX_POWER_LEVEL                  (8) 
static void tx_power_set(void)
{
    ret_code_t err_code = sd_ble_gap_tx_power_set(BLE_GAP_TX_POWER_ROLE_ADV, m_advertising.adv_handle, TX_POWER_LEVEL);
    APP_ERROR_CHECK(err_code);
}


#if NRF_MODULE_ENABLED(BLE_DFU)

static void advertising_config_get(ble_adv_modes_config_t *p_config)
{
    memset(p_config, 0, sizeof(ble_adv_modes_config_t));

    p_config->ble_adv_fast_enabled  = true;
    p_config->ble_adv_fast_interval = APP_ADV_INTERVAL;
    p_config->ble_adv_fast_timeout  = APP_ADV_DURATION;
}


static void disconnect(uint16_t conn_handle, void *p_context)
{
    UNUSED_PARAMETER(p_context);

    ret_code_t err_code = sd_ble_gap_disconnect(conn_handle, BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
    if(err_code != NRF_SUCCESS)
    {
        NRF_LOG_WARNING("Failed to disconnect connection. Connection handle: %d Error: %d", conn_handle, err_code);
    }
    else
    {
        NRF_LOG_DEBUG("Disconnected connection handle %d", conn_handle);
    }
}

/**@brief Function for handling dfu events from the Buttonless Secure DFU service
 *
 * @param[in]   event   Event from the Buttonless Secure DFU service.
 */
static void ble_dfu_evt_handler(ble_dfu_buttonless_evt_type_t event)
{
    switch(event)
    {
        case BLE_DFU_EVT_BOOTLOADER_ENTER_PREPARE:
        {
            NRF_LOG_INFO("Device is preparing to enter bootloader mode.");

            // Prevent device from advertising on disconnect.
            ble_adv_modes_config_t config;
            advertising_config_get(&config);
            config.ble_adv_on_disconnect_disabled = true;
            ble_advertising_modes_config_set(&m_advertising, &config);

            // YOUR_JOB: Disconnect all other bonded devices that currently are connected.
            // 		   This is required to receive a service changed indication
            // 		   on bootup after a successful (or aborted) Device Firmware Update.
            uint32_t conn_count = ble_conn_state_for_each_connected(disconnect, NULL);
            NRF_LOG_INFO("Disconnected %d links.", conn_count);
            break;
        }

        case BLE_DFU_EVT_BOOTLOADER_ENTER:
            // YOUR_JOB: Write app-specific unwritten data to FLASH, control finalization of this
            //           by delaying reset by reporting false in app_shutdown_handler
            NRF_LOG_INFO("Device will enter bootloader mode.");
            break;

        case BLE_DFU_EVT_BOOTLOADER_ENTER_FAILED:
            NRF_LOG_ERROR("Request to enter bootloader mode failed asynchroneously.");
            // YOUR_JOB: Take corrective measures to resolve the issue
            //           like calling APP_ERROR_CHECK to reset the device.
            break;

        case BLE_DFU_EVT_RESPONSE_SEND_ERROR:
            NRF_LOG_ERROR("Request to send a response to client failed.");
            // YOUR_JOB: Take corrective measures to resolve the issue
            //           like calling APP_ERROR_CHECK to reset the device.
            APP_ERROR_CHECK(false);
            break;

        default:
            NRF_LOG_ERROR("Unknown event from ble_dfu_buttonless.");
            break;
    }
}

/**@brief Handler for shutdown preparation.
 *
 * @details During shutdown procedures, this function will be called at a 1 second interval
 *          untill the function returns true. When the function returns true, it means that the
 *          app is ready to reset to DFU mode.
 *
 * @param[in]   event   Power manager event.
 *
 * @retval  True if shutdown is allowed by this power manager handler, otherwise false.
 */
static bool app_shutdown_handler(nrf_pwr_mgmt_evt_t event)
{
    switch(event)
    {
        case NRF_PWR_MGMT_EVT_PREPARE_DFU:
            NRF_LOG_INFO("Power management wants to reset to DFU mode.");
            // YOUR_JOB: Get ready to reset into DFU mode
            //
            // If you aren't finished with any ongoing tasks, return "false" to
            // signal to the system that reset is impossible at this stage.
            //
            // Here is an example using a variable to delay resetting the device.
            //
            // if (!m_ready_for_reset)
            // {
            //      return false;
            // }
            // else
            //{
            //
            //    // Device ready to enter
            //    uint32_t err_code;
            //    err_code = sd_softdevice_disable();
            //    APP_ERROR_CHECK(err_code);
            //    err_code = app_timer_stop_all();
            //    APP_ERROR_CHECK(err_code);
            //}
            break;

        default:
            // YOUR_JOB: Implement any of the other events available from the power management module:
            //      -NRF_PWR_MGMT_EVT_PREPARE_SYSOFF
            //      -NRF_PWR_MGMT_EVT_PREPARE_WAKEUP
            //      -NRF_PWR_MGMT_EVT_PREPARE_RESET
            return true;
    }

    NRF_LOG_INFO("Power management allowed to reset to DFU mode.");
    return true;
}

//lint -esym(528, m_app_shutdown_handler)
/**@brief Register application shutdown handler with priority 0.
 */
NRF_PWR_MGMT_HANDLER_REGISTER(app_shutdown_handler, 0);

static void buttonless_dfu_sdh_state_observer(nrf_sdh_state_evt_t state, void *p_context)
{
    if(state == NRF_SDH_EVT_STATE_DISABLED)
    {
        // Softdevice was disabled before going into reset. Inform bootloader to skip CRC on next boot.
        nrf_power_gpregret2_set(BOOTLOADER_DFU_SKIP_CRC);

        //Go to system off.
        nrf_pwr_mgmt_shutdown(NRF_PWR_MGMT_SHUTDOWN_GOTO_SYSOFF);
    }
}

/* nrf_sdh state observer. */
NRF_SDH_STATE_OBSERVER(m_buttonless_dfu_state_obs, 0) =
{
    .handler = buttonless_dfu_sdh_state_observer,
};


#endif


/**@brief Function for initializing services that will be used by the application.
 */
static void services_init(void)//服务初始化
{
    uint32_t           err_code;
    ble_nus_init_t     nus_init;
    nrf_ble_qwr_init_t qwr_init = {0};

    // Initialize Queued Write Module.
    qwr_init.error_handler = nrf_qwr_error_handler;

    err_code = nrf_ble_qwr_init(&m_qwr, &qwr_init);
    APP_ERROR_CHECK(err_code);

    // Initialize NUS.
    memset(&nus_init, 0, sizeof(nus_init));

    nus_init.data_handler = nus_data_handler;

    err_code = ble_nus_init(&m_nus, &nus_init);
    APP_ERROR_CHECK(err_code);

#if NRF_MODULE_ENABLED(BLE_DFU)		
	ble_dfu_buttonless_init_t dfus_init = {0};	
	// Initialize DFU.
    dfus_init.evt_handler = ble_dfu_evt_handler;
    err_code = ble_dfu_buttonless_init(&dfus_init);
    APP_ERROR_CHECK(err_code);
#endif

#if NRF_MODULE_ENABLED(BLE_GDX)
    ble_gdx_init_t     gdx_init;

    // Initialize GDX.
    memset(&gdx_init, 0, sizeof(gdx_init));

    gdx_init.data_handler = gdx_data_handler;

    err_code = ble_gdx_init(&m_gdx, &gdx_init);
    APP_ERROR_CHECK(err_code);

#endif
}

/**@brief Application main function.
 */
int main(void)
{
    bool erase_bonds;
    uint8_t heart_last = 0;
    
    g_sleep_mode = false;
    g_enter_sleep = true;

    g_ble_running_bean_connect  = false;
    g_ble_pad_connect           = false;

    // Initialize.
//    uart_init();
    log_init();
    
    timers_init();
    buttons_leds_init(&erase_bonds);
    power_management_init();
    #if 1
    db_discovery_init();
    
    ble_stack_init();
    gap_params_init();
    gatt_init();
    services_init();
    advertising_init();
    tx_power_set();
    conn_params_init();

    nus_c_init();

    // Start execution.
    NRF_LOG_INFO("Debug logging for UART over RTT started.");
#endif
	//电池管理
	bat_manager_init();

    //flash init
    flash_init();

	//恢复系统时间
	time_init();

    //flash存储数据管理
	his_data_manage_init();

	
//  printf("lvgl started.");
    lcd_display_init();
    
    log_resetreason();


    //WM8978 I2C初始化
    uint8_t res = wm8978_Init();
	if (res)
	{
		NRF_LOG_INFO(" wm8978 init failed: %d !!!", res);
		while (1);	/* 停机 */
	}
	NRF_LOG_INFO("wm8978 init successed");	


    btime_syc_flag  = false;

    extern void KalmanFilterPara_init(void);
    KalmanFilterPara_init();

    //从flash恢复系统数据
    Flash_Read((uint8_t*)&g_sysmng_info, SPI_FLASH_SYSINFO_ADDR_START, sizeof(g_sysmng_info));

    //首次使用，初始化默认信息
    if (0xAACC != g_sysmng_info.u16FirstStart)
    {
        g_sysmng_info.u16FirstStart = 0xAACC;
        g_sysmng_info.u8BeanPaired  = 0;

        //保存默认信息
        Flash_Erase_Sector(SPI_FLASH_SYSINFO_ADDR_START);
        Flash_Write((uint8_t*)&g_sysmng_info, SPI_FLASH_SYSINFO_ADDR_START, sizeof(g_sysmng_info));
    }
    
    application_init();
    // Enter main loop.
    for (;;)
    {
        idle_state_handle();
//        nrf_delay_ms(1000);
    }
}


/**
 * @}
 */
